bool enable_depth_ctrl
float64 depth_desired
uint16 pwm_max 
uint32 KI
uint32 KP
uint32 KD
